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I.  INTRODUCTION 


The  Naval  Postgraduate  School  Physics  Department  has  implemented  a  robotic 
manipulation  laboratory  (RML)  to  explore  learning  opportunities  for  various  student 
experiments.  The  focus  of  this  project  is  to  understand  and  apply  the  kinematics  and 
dynamics  for  a  6  degree  of  freedom  (DOF)  Kinova  JACO  robotic  arm,  in  a  controlled  lab 
environment,  for  various  predetermined  tasks  under  glove  sensor  control. 

A.  RESEARCH  FOCUS 

The  JACO  arm  is  a  sophisticated  and  complex  manipulator.  End  effector,  the 
hand  at  the  end  of  manipulator,  trajectory  and  path  planning  are  operationally  and 
mathematically  challenging  for  the  6  DOF  arm.  It  was  therefore  deemed  necessary  to 
implement  the  manipulator  in  three  phases:  (1)  Startup  and  Development,  (2)  Lab 
Implementation,  (3)  and  Operational  Demonstrations 

This  research  project  centered  on  Phase  1,  while  focusing  on  three  subareas: 

•  JACO  Manipulator  Set  Up  And  Integration 

•  Robot  Operating  System  (ROS)  Controller  Development 

•  TeleOp  Communication  Infrastructure 

The  overarching  goal  for  these  focus  areas  was  to  integrate  the  JACO  arm  into  an 
efficient,  real-time  and  humanlike  system  where  the  trajectory  motion  emulates  natural 
human  arm  movement.  Lab  demonstrations  will  show  manipulator  interaction  under 
glove  control.  An  operator  will  control  the  manipulator  with  the  glove  controller,  which 
is  accomplished  by  his  or  her  respective  computer  communicating  via  the  Internet  and 
video  feedback,  as  illustrated  in  Figure  1 . 
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Figure  1.  Overall  system  containing  robotic  arm,  controller  and  communication 
infrastructure.  An  operator  will  control  the  manipulator  with  the  glove 
controller,  with  their  respective  computers  communicating  via  the  Internet 

and  video  feedback. 


B.  EXPECTATIONS 

The  expectations  for  Phase  1  are  to  have  selected  a  robotic  arm,  design  a 
controller  and  establish  a  communications  infrastructure.  I  will  address  the  following 
questions: 

•  Do  we  need  to  build  a  robotic  arm  from  scratch?  If  not,  what  is  the  best 
robotic  arm  on  the  market  that  fits  our  parameters? 

•  How  do  we  make  a  controller  that  is  efficient  and  quickly  learned? 

•  How  can  we  improve  on  our  design? 
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II.  THEORY 


The  fundamental  physics  used  for  the  RML  include  Euler  angles,  dynamics,  and 
the  use  of  Denavit-Hartenberg  (DH)  parameters.  This  chapter  will  briefly  explain  the 
incorporation  of  these  methods  in  the  system. 

A.  EULER  ANGLES 

The  controller  needs  to  be  able  to  produce  an  output  for  the  manipulator  to 
emulate.  The  IMU  provides  raw  data  via  the  accelerometer  and  magnetometer  based  on 
the  position  of  the  user’s  hand.  The  microcontroller  reads  the  raw  data  and  converts  the 
data  to  Euler  angles,  in  the  getOrientation  function,  to  generate  the  three-dimensional 
orientation  data  [1]. 

Euler  angles  allow  us  to  express  the  orientation  of  any  reference  frame  as  an 
arrangement  of  three  elemental  rotations  correlated  to  a  known  standard  orientation, 
represented  by  another  frame  [2].  There  are  several  different  interpretations  of  Euler 
angles;  however,  the  geometrical  definition  is  easiest  to  understand.  The  geometrical 
definition  centers  on  the  axes  of  the  original  and  rotated  reference  frames  and  an 
additional  axis  called  the  line  of  nodes  [2].  The  line  of  nodes  is  the  intersection  of  the  xy 
and  the  XY  coordinate  planes  seen  in  Figure  2  [2]. 
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Figure  2.  Euler  angles  depicting  rotations  about  z,  N,  and  Z  axes  with  xyz 
(original)  system  in  blue,  XYZ  (rotated)  system  in  red  and  the  line  of 
nodes  (N)  in  green  from  [2], 


The  getOrientation  function  uses  the  raw  data  from  the  IMU  and  inserts  it  into 
Equations  1,  2  and  3  from  [1],  The  roll  (i//),  pitch  (0)  and  heading  (</>)  are  calculated 
with  the  variables  from  Figure  2.  A  positive  roll  angle  is  the  clockwise  rotation  about  the 
positive  X-axis,  a  positive  pitch  angle  is  the  clockwise  rotation  about  the  positive  Y-axis 
and  a  positive  heading  angle  is  the  clockwise  rotation  about  the  positive  Z-axis  [2]. 


roll:  ^  =  arctan  2 


V 

UJ 


pitch:  6  =  arctan 


-x 


y  sin  (roll)  +  z  cos  (roll) 


(1) 

(2) 


heading:  (f>  =  arctan  2 


z  sin  ( roll )  -  y  cos  ( roll ) 


;  cos  ( pitch)  +  y  sin  ( pitch  )  sin  ( roll)  +  z  sin  ( pitch  )  cos  ( roll ) 


(3) 
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B. 


DYNAMICS  AND  DH  PARAMETERS 


Dynamics  is  the  study  of  forces  and  their  effect  on  motion  [3],  Many  factors  have 
to  be  taken  into  account  when  finding  the  trajectory  a  manipulator  travels.  Principles  of 
Robot  Motion  states,  “A  trajectory  is  a  system  dynamics  problem  that  requires  knowledge 
of  the  masses  and  inertias  of  the  system,  actuator  limits  and  forces  such  as  gravity  and 
friction”  [4],  Kinova  simplified  the  work  for  the  JACO  arm  with  their  proprietary 
algorithms  and  transformations  from  DH  parameters  to  actual  JACO  physical  angles. 

Using  Lagrangian  dynamics  for  a  manipulator  allows  for  the  use  of  computer 
algorithms  for  calculating  equations  of  motion  [4].  Subtracting  the  potential  energy  from 
the  kinetic  energy  yields  the  Lagrangian  of  any  mechanical  system  seen  in  Equation  4.  L 
is  the  Lagrangian,  K  is  the  kinetic  energy,  V  is  the  potential  energy  and  q  is  a  vector  of 
generalized  coordinates: 

L(q,q)  =  K(q,q)-V(q)  (4) 

The  Lagrangian  equations  of  motion  can  be  derived  via  Equation  5  where  u  is  a 
generalized  force: 

d  dL  8L 

- =  u  (5) 

dt  dq  dq 

Once  all  forces  are  found  for  the  configuration  of  the  system,  then  the  forces  can 
be  rewritten  into  a  2nd  order  differential  equation  as  in  Equation  6.  M  (q)  is  the  inertial 

matrix,  C{q,q)q  is  a  vector  of  velocity  products  and  g{q)  is  a  vector  of  gravitational 
forces. 

u  =  M(q)q  +  C(q,q)q  +  g(q )  (6) 

With  the  Lagrangian  equation  of  motion,  calculating  planar  rotation  and  spatial 
rotation  for  a  rigid  body  is  possible.  Applying  the  kinetic  energy  of  the  system  to 
Lagrange’s  equation  yields  the  torque  about  the  chosen  axis.  The  appeal  of  Lagrange’s 
equation  is  that  it  uses  the  fewest  possible  numbers  to  represent  the  orientation;  however 
the  equations  are  complicated  [4]. 
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The  use  of  DH  parameters  is  required  to  simplify  the  mathematics  necessary  to 
move  the  end  effector  of  the  manipulator  to  a  point  in  space.  The  DH  parameters  do  not 
include  the  hand,  only  the  links.  DH  parameters  are  assigned  to  each  link  in  a 
manipulator  and  are  labeled  69 ,  an  ti  and  ai  [5].  ai  and  aj  are  the  link  length  and  link 
twist,  respectively,  and  since  they  are  detennined  by  the  construction  of  the  links  they  are 
constants  [5].  The  only  time  ai  is  a  variable  is  if  the  link  is  attached  to  a  prismatic  joint. 

di  and  (9  are  the  link  offset  and  joint  angle,  respectively,  and  establish  the  location  of 
the  connected  link  [5].  dt  is  constant  and  69  is  the  variable  for  a  revolute  joint  [5]. 

To  relate  the  end  effector  to  the  base  of  the  manipulator,  using  homogeneous 
transformations,  we  have  to  establish  reference  frames  for  each  link  and  correlate  them  to 
each  other.  Section  8.6.2  of  [5]  lists  three  rules  for  establishing  link  coordinate  frames  to 
get  Figure  3. 


Figure  3.  Coordinate  frames  for  links  and  joints  to  use  in  the  DH 

transformationfrom  [5] 


Using  Figure  3  to  relate  each  successive  link  coordinate  frames,  we  can  develop  a 
DH  matrix;  see  Equation  7  [5]. 
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where  yellow  is  the  rotation  matrix,  red  is  the  position  vector,  green  is  the  perspective 
transform  and  orange  is  the  scale  factor.  The  first  column  of  the  rotation  matrix  is  called 
the  normal  vector  and  makes  up  the  x'  -axis  unit  vector  of  reference  frame  2  in  terms  of 
reference  frame  1  [5].  The  second  and  third  columns  of  the  rotation  matrix  make  up  the 
orientation  vector  (y'-axis  unit  vector)  and  approach  vector  (z'-axis  unit  vector), 
respectively,  of  reference  frame  2  [5].  The  position  vector  tells  us  where  the  origin  of 
reference  frame  2  is  relative  to  reference  frame  1  [5]. 

It  is  now  possible  to  find  a  forward  solution  for  a  6DOF  manipulator  to  relate  the 
end  effector  to  the  base  of  the  manipulator.  For  an  n-DOF  manipulator,  the  expression  for 
the  DH  operator  is  given  by  [5]: 

T  =  A(n-l)n...  (8) 

therefore  when  n  =  6  , 

T  =  A0lAl2A23A34A45A56  (9) 

where  the  DH  operator  is  the  product  of  each  DH  matrix  for  each  link.  The  final  position 
of  the  end  effector  can  be  found  by  operating  the  DH  operator  on  the  initial  end  effector 
position,  see  Equation  10. 

Final  Position  =  T^Pv  Pv  P_  lj  (10) 
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III.  EQUIPMENT  AND  LAB  SETUP 


In  this  chapter,  we  describe  the  Kinova  JACO  Arm,  the  glove  controller  and  the 
communications  infrastructure. 

A.  THE  JACO  ARM 

The  JACO  manipulator,  see  Figure  4,  closely  mimics  the  motion  of  the  human 
arm.  It  has  6  DOF  with  a  maximum  reach  of  90  cm  and  a  maximum  linear  speed  of  20 
cm/s  [6],  The  arm  weighs  5.3  kg  and  can  lift  a  maximum  payload  of  2.5  kg  at  mid-range 
and  1.5  kg  at  full  extension  [6].  Kinova  provides  ROS  open-source  code,  to  ease  the 
transition  from  joystick  control  to  tele-optic  control. 


Figure  4.  KINOVA  JACO  6  DOF  robotic  arm  attached  to  rolling  table 

simulating  lifting  a  bottle. 
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The  JACO  arm  also  comes  with  standalone  software  called  JACOSOFT.  The 


software  allows  the  operator  to  see  general  information  including: 

•  Arm  trajectory,  Figure  5 

•  Arm  health,  Figure  6 

It  also  allows  the  operator  to  change  operational  configurations: 

•  Right-handed  or  left-handed  preference 

•  Sensitivity 

•  Speed 

•  Protection  zones 
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Figure  5.  JACOSOFT  Health  Centerused  to  monitor  JACO  arm  parameters. 

Force,  current,  command,  and  position  of  each  joint  and  fingers  are  monitored  to  ensure 
the  arm  is  operating  normally  and  as  desired. 
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Figure  6.  JACOSOFT  trajectory  pageused  to  monitor  JACO  arm  motion  during 
operation.  An  operator  can  get  points  along  a  path  the  manipulator  is  moving  and  saved 

as  a  trajectory  to  run  at  a  later  time. 


JACOSOFT  prohibits  program  code  modifications  for  arm  operation;  however 
users  can  store  path  trajectories  for  various  operations  for  future  use.  An  example  would 
be  picking  up  a  cup  of  water  and  returning  it  to  its  original  position.  JACOSOFT  allows 
users  to  get  comfortable  controlling  the  arm. 

The  JACO  arm  was  bolted  to  a  rolling  table  for  lab  flexibility,  see  Figure  7.  We 
added  an  electric  bus  so  that  we  could  power  the  arm  and  associated  ancillary  equipment 
including  computer,  network  and  camera  from  one  location. 
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Figure  7.  JACO  Ann  attached  to  rolling  table  for  flexibility  to  move  around  the 
campus  as  needed  and  to  simulate  controlling  the  arm  if  attached  to  a 
moving  vehicle. 


B.  CONTROLLER 

As  a  replacement  for  the  joystick,  a  resistive  glove  controller  was  implemented  to 
invoke  tele-optic  control  via  natural  hand  movement.  With  the  glove  on  a  user’s  hand,  the 
user  moves  the  manipulator  up/down,  forward/backward  and  rotates  it  with  regular  hand 
motion.  To  invoke  grasping  action,  we  fitted  the  glove  with  flexible  resistive  sensors 
shown  in  Figure  8.  The  glove  was  modeled  after  prior  work  cited  in  open  source  literature 
in  [7].  The  glove  consist  of  three  main  components;  the  IMU,  microcontroller  and  flex 
sensors  shown  in  Figure  8. 
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Figure  8.  Fully  assembled  glove  controller  with  flex  sensors,  IMU  and  Arduino 
Uno  Microcontroller. 


1.  Inertial  Measurement  Unit 

For  the  IMU,  we  chose  Adafruit’s  10  DOF  breakout  board  shown  in  Figure  9. 
Adafruit’s  website  states,  “the  board  captures  ten  distinct  types  of  motion  or  orientation 
related  data  by  combining  a  3-axis  accelerometer,  a  3-axis  gyroscope  and  a  barometric 
pressure  sensor  to  provide  stable  and  reliable  readings”  and  “when  the  accelerometer  and 
gyroscope  are  paired,  they  can  be  used  as  an  inertial  guidance  system  or  3D  motion 
capture”  [8].  The  right  top  of  the  breakout  board  has  the  orientation  of  x,  y  and  z  and  the 
corresponding  Euler  angles  references.  Euler  angles  describe  orientation  (in  degrees) 
around  a  single  reference  point  in  three-dimensional  space  [1]. 
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Figure  9.  IMU  containing  an  accelerometer,  gyroscope  and  barometric  pressure 
sensors  from  [9]  used  to  get  the  pitch,  roll  and  yaw  to  control  the 

JACO  arm. 


2.  Microcontroller 

The  Arduino  Uno  microcontroller  controls  raw  data  from  the  sensors,  contains 
open  source  code,  is  small  and  has  easy-to-use  software.  The  Uno  has  14  digital 
input/output  pins  (of  which  6  can  be  used  as  PWM  outputs),  6  analog  inputs,  a  16  MHz 
ceramic  resonator,  a  USB  connection,  a  power  jack,  an  ICSP  header,  and  a  reset  button  as 
can  be  seen  in  Figure  10  from  [9].  For  Prototyping,  the  Uno  is  connected  to  a  laptop  via  a 
USB  connection.  For  Operations,  the  program  is  loaded  to  the  Uno  in  stand-alone  mode. 
Here  we  provide  external  power  and  communicate  via  a  Wi-Fi  shield. 
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Figure  10.  Arduino  Uno  from  [9]  used  on  the  glove  controller  to  collect  analog 
data  from  the  flex  sensors  and  I2C  from  the  IMU  to  send  to  the  JACO  Arm. 


3.  Flex  Sensors 

Three  4.5  inch  Spectra  Symbol  flex  sensors,  are  used  for  end  effector  control,  see 
Figure  1 1 .  The  sensors  consist  of  conductive  and  resistive  ink  sections  on  a  Kapton 
substrate  [10].  The  flex  sensor  has  a  flat  resistance  ranging  7-13  kQ  and  a  maximum 
resistance  of  two  times  the  flat  resistance  for  a  180°  pinch  bend  [10].  One  was  used  for 
the  thumb,  and  the  other  two  were  for  the  first  two  fingers.  The  flex  sensors  were  sewn  in 
place  at  each  knuckle  of  its  corresponding  finger  to  ensure  that  they  would  bend  with  the 
finger. 
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Figure  1 1 .  Flex  sensorused  on  the  glove  controller  to  operate  the  end  effectors  on 

the  JACO  Arm,  from  [10]. 

4.  Assembly 

In  Figure  12,  a  breadboard  is  used  to  hold  the  IMU,  resistors  and  connections.  All 
components  were  soldered  onto  the  breadboard  ensuring  contacts  would  not  break  with 
movement.  We  strengthened  the  links  with  the  flex  sensors  by  soldering  the  wires  to  the 
connectors,  heat  shrinking  and  electrical  taping  each  connector  as  recommended  in  [7]. 
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Figure  12.  Electrical  schematic  of  fully  assembled  glove  controller. 


C.  COMMUNICATION  INFRASTRUCTURE 

We  chose  ROS  as  the  operating  system  to  support  tele-optic  control  of  the  JACO 
arm.  It  has  been  around  for  many  years  and  has  a  vast  library  of  open  source  code  to  use 
for  programming.  ROS  has  a  collection  of  libraries  to  make  writing  robot  software 
easier  [11].  ROS  allows  users  to  create  packages  (software).  Within  the  package,  the  user 
can  create  nodes  which  are  functions  that  perform  computations  [11].  Nodes  talk  to  each 
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other  via  Topics.  Topics  are  zones  that  transport  data  and  to  which  nodes  can  subscribe  or 
publish  [11].  ROS  simplifies  the  infrastructure  process  and  makes  it  easier  for  the 
programmer.  Kinova  has  a  primary  ROS  package  for  customers  to  configure  their  JACO 
ann  as  needed. 
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IV.  OPERATION 


A.  CONTROLLER 

The  Uno  microcontroller  is  the  brains  for  the  operation  of  the  glove  controller.  It 
receives  the  raw  data  from  the  flex  sensors  and  IMU  and  sends  the  signal  via  ROS  to  the 
JACO  arm. 


For  the  flex  sensors,  as  the  user’s  fingers  close,  the  resistance  changes  thereby 
regulating  output  voltage  sent  to  ports  AO,  A1  and  A2  of  the  Uno  microcontroller.  The 
microcontroller  sends  a  signal  to  the  JACO  arm  to  shut  the  end  effector.  When  the  user 
brings  their  fingers  back  to  natural  positions,  the  end  effector  will  reopen.  Output  voltage 
fluctuates  with  flex  sensor  varying  resistance  per  Equation  10. 


V  =  V 

out  in 


R, 


\  R\+  R2  J 


;  Rx  =  Flex  Sensor  Resistance 


R2  =  22kQ 


(11) 


Figure  13  is  the  flex  sensor’s  electrical  diagram  showing  the  regulation  of  5V  for 
output  voltage  to  the  Uno  microcontroller.  The  microcontroller  will  see  voltages  ranging 
from  3.79  V  to  2.29  V  depending  on  the  initial  flat  resistance  and  bend. 


V»  =  5V 


Figure  13.  Voltage  divider,  for  each  flex  sensor,  which  supplies  analog  voltage  to 

the  Arduino  Uno  microcontroller. 
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For  the  IMU,  the  Uno  microcontroller  uses  an  attitude  and  heading  reference 
system  (AHRS)  sketch  to  read  raw  data  from  the  board’s  accelerometer/magnetometer 
and  convert  it  into  Euler  angles  [1],  Therefore,  the  user’s  hand  position  provides  a  three- 
dimensional  orientation  data  stream  in  terms  of  Roll  (x),  Pitch  (y)  and  Yaw  (z)  in 
degrees.  The  data  is  sent  to  the  JACO  ann  via  ROS.  The  Uno  microcontroller  is  a  node  in 
the  JACO  package. 

B.  TRAJECTORY  CONTROL 

The  JACO  arm  contains  6  actuators  and  three  lingers.  The  orientation  signals 
from  the  glove  are  passed  to  the  actuators  via  ROS  to  energize  the  actuators  that  move  the 
manipulator.  ROS  reads  the  Uno  microcontroller  as  a  node,  in  the  JACO  ROS  package, 
and  then  publishes  to  a  topic.  The  user  only  controls  movements  of  the  end  effector  [12]. 
Kinova  uses  proprietary  algorithms  to  transform  DH  parameters  to  JACO  physical  angles 
to  pilot  the  different  joints  automatically  [12].  The  manipulator  has  joint  and  speed  limits 
for  protection.  The  user  is  capable  of  adjusting  the  speed  of  the  manipulator  as  long  as  it 
stays  below  the  max  of  20  cm/s. 
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V.  RESULTS  AND  CONCLUSIONS 


JACO  arm  testing  and  glove  experiments  were  completed.  The  JACO  software 
was  installed  and  verified  for  standalone  operations  within  its  range  of  motion.  Testing  of 
ROS  and  glove/manipulator  interaction  proved  ineffective.  Successful  testing  of  the 
sensors  on  the  glove  confirmed  regular  hand  movements’  simulation. 

A.  RESULTS 

To  verify  the  glove  controller  functioned  correctly,  it  was  tested  using  the 
Arduino  and  visually  confirmed  with  the  3D  simulator  Processing  software.  The  coding 
for  the  glove  controller  is  in  Appendix  A. 

The  flex  sensors  were  tested  first.  Data  was  collected  in  Table  1  showing  the 
results  when  the  user  contracts  their  fingers  (thumb,  index  finger  and  middle  finger)  and 
then  returning  them  to  their  nonnal  positions.  In  the  coding,  the  voltage  output  was 
mapped  to  an  angle  roughly  proportional  to  the  bend  angle  of  the  user’s  fingers. 


Table  1.  Flex  sensors  datawhile  contracting  and  subsequent  release  of  user’s 
fingers.  The  bend  angles  are  analog  data  converted  from  the  output  voltage,  using 


Equation  1 1,  in  the  Arduino  code. 


Bend  Angles  (deg) 

Thumb 

Index  Finger 

Middle  Finger 

34 

37 

31 

40 

81 

63 

40 

106 

87 

49 

131 

100 

63 

144 

114 

75 

167 

117 

111 

170 

146 

124 

151 

149 

142 

139 

163 

143 

127 

156 

150 

117 

153 

94 

102 

115 

49 

91 

83 

40 

69 

73 

39 

16 

17 
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This  data  was  then  plotted  in  Figure  14,  showing  how  the  angle  increases  while 
the  fingers  contract  and  decreases  back  to  original  reading  when  the  fingers  are  released. 
Future  coding  will  be  developed  having  the  JACO  arm  close  the  end  effector  when  the 
bend  angle  reaches  60°  and  reopens  when  it  returns  below  50° .  The  fingers  will  stop 
closing  on  an  object  when  the  force  reaches  7N  per  default  programming  [12]. 


(a)  Flex  Sensors  Change  in  Bend  Angle  as  Fingers  Bend  Close  and  then  Open 


Figure  14.  Plots  for  flex  sensors  datawhile  contracting  and  subsequent  release  of 
user’s  fingers.  The  plot  shows  the  coding  works  allowing  us  to  use  the 
output  to  control  the  end  effector. 


The  IMU  was  tested  using  an  existing  example  sketch  from  the  Processing 
software  to  display  IMU  operation.  The  user  changes  the  orientation  of  the  object  based 
on  the  position  of  the  glove.  The  sketch  receives  3D  orientation  data  from  the 
LSM303DLFIC  3-axis  accelerometer  and  displays  it  via  the  3D  simulator;  see  Figures 
15(a)-  15(d). 
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(C)  (d) 


Figure  15.  Simulation  of  IMU  output  from  glove  controller.  Figures  14(a)-14(d) 
show  a  3D  object,  a  rabbit  in  this  simulation,  orient  itself  in  the  same 
orientation  of  the  user’s  hand. 


B.  CONCLUSION 

The  JACO  arm  works  as  desired  with  smooth  operation  and  the  ability  to  vary  the 
speed  of  operation.  The  JACOSOFT  software  allowed  us  to  become  familiar  with  the 
operation  of  the  manipulator  both  with  the  joystick  and  trajectory  mapping.  The  Health 
Monitor  for  the  JACO  arm  displayed  the  force,  current  and  position  of  each  joint  and 
finger  allowing  us  to  become  familiar  with  the  parameters. 

ROS  did  not  successfully  communicate  with  the  JACO  arm.  The  driver  in  the 
JACO-ROS  package  was  faulty  and  needs  to  be  further  investigated.  An  alternate  choice 
for  communication  would  be  the  Visual  Studio  JACO  API  written  by  Kinova.  Developer 
examples  are  available. 
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APPENDIX 


This  sketch  was  a  combination  of  example  sketches  from  [1]  and  [7].  I  made 
modifications  to  the  sketch  for  our  design  and  used  it  in  the  Processing  Software  3D 
simulator  to  verify  proper  IMU  and  flex  sensors  operation. 


#include  <Wire.h> 

#include  <Adafruit_Sensor.h> 

#include  <Adafruit_LSM303_U.h> 

#include  <Adafruit_BMP085_U.h> 

#include  <Adafruit_Simple_AHRS  .h> 

//  Create  sensor  instances. 

Adafruit_LSM303_Accel_Unified  accel(30301); 
Adafruit_LSM303_Mag_Unified  mag(30302); 

Adafruit_BMP085_Unified  bmp(  1 8001); 

//  Create  simple  AHRS  algorithm  using  the  above  sensors. 
Adafruit_Simple_AHRS  ahrs(&accel,  &mag); 

//  Update  this  with  the  correct  SLP  for  accurate  altitude  measurements 
float  seaLevelPressure  =  SENSORS_PRESSURE_SEALEVELHPA; 

void  setup() 

{ 

Serial. begin(l  15200); 

Serial.println(F("Adafruit  10  DOF  Board  AHRS  Example"));  Serial.println(""); 

//  Initialize  the  sensors. 
accel.begin(); 
mag.begin(); 
bmp.begin(); 

} 

void  loop(void) 

{ 

sensors_vec_t  orientation; 

//  Use  the  simple  AHRS  function  to  get  the  current  orientation. 

Serial.println(" - IMU - "); 

if  (ahrs.getOrientation(&orientation)) 

{ 

/*  ’orientation’  should  have  valid  .roll  and  .pitch  fields  */ 
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Serial.print(F("Orientation:  ")); 

Serial.print(orientation.roll); 

Serial.print(F("  ")); 

S  erial  .print(orientation  .pitch) ; 

Serial.print(F("  ")); 

Serial.print(orientation.heading); 

Serial.println(F("")); 

} 

//  Calculate  the  altitude  using  the  barometric  pressure  sensor 
sensors_event_t  bmp_event; 
bmp.getEvent(&bmp_event); 
if  (bmp_event.pressure) 

{ 

/*  Get  ambient  temperature  in  C  */ 
float  temperature; 

bmp .  getT  emp  erature( &temperature); 

/*  Convert  atmospheric  pressure,  SLP  and  temp  to  altitude  */ 
Serial.print(F("Alt:  ")); 

Serial.print(bmp.pressureToAltitude(seaLevelPressure, 
bmpcvcnt. pressure, 
temperature)); 

S  erial  .println(F( "")) ; 

/*  Display  the  temperature  */ 

Serial.print(F("Temp:  ")); 

Serial.print(  temperature); 

S  erial  .println(F( "")) ; 

} 

//Defines  analog  input  variables 
int  thumb,  degrees  1; 
int  finger  1,  degrees2; 
int  finger2,  degrees3; 

//Read  the  voltage  from  the  voltage  divider  (sensor  plus  resistor) 
thumb  =  analogRead(O); 
finger  1  =  analogRead(l); 
finger2  =  analogRead(2); 

//  convert  the  voltage  reading  to  degrees 
degrees  1  =  map(thumb,  694,  575,  0,  180); 
degrees2  =  map(fingerl,  666,  548,  0,  180); 
degrees3  =  map(finger2,  679,  573,  0,  180); 

//  print  out  the  result 
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Serial.println(" - FLEX  SENSORS - "); 

Serial.print("Thumb  Analog  Input:  ");  Serial.print(thumb,DEC); 
Serial.print("  Degrees:  ");  Serial.println(degreesl,DEC); 
Serial.print("Fingerl  Analog  Input:  ");  Serial.print( finger  1, DEC); 
Serial.print("  Degrees:  ");  Serial.println(degrees2,DEC); 
Serial.print("Finger2  Analog  Input:  ");  Serial.print(finger2,DEC); 
Serial.print("  Degrees:  ");  Serial.println(degrees3,DEC); 


delay(lOO); 
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